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[57] ABSTRACT 

The present invention relates to a method for estimating the 
motion of a target relative to an observer station and a 
system for performing the method. The method includes the 
steps of: generating data representative of the motion of the 
target relative to the observer station during first, second, 
and subsequent measurement legs; processing the data to 
yield smoothed estimate of the bearing, bearing rate, and 
bearing acceleration of the target during each measurement 
leg; and processing the smoothed estimates of the bearing, 
bearing rate, and bearing acceleration of the target to provide 
an estimate of the position of the target relative to the 
observer station and the velocity of the target. The system 
for performing the method includes a data preprocessing 
subsystem for generating the smoothed estimate of the 
bearing rate, bearing and bearing acceleration, a passive 
localization and target motion analysis subsystem, and a 
trajectory modelling subsystem having a first module for 
creating a model of the observer station motion and a second 
module for creating a model of the motion of the target. 

9 Claims, 3 Drawing Sheets 
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RECURSIVE METHOD FOR TARGET responding statistically supportable candidate trajectory 

MOTION ANALYSIS motion estimate of target motion thereby to provide indicia 

of an overall trajectory of the target. 

STATEMENT OF GOVERNMENT INTEREST U.S. Pat. No. 5,471,434 to Davis et al. illustrates a system 

. , s for facilitating the tracking of a target vehicle in connection 

The invention described herein may be manufactured and ^ successively received acoustic sensor signal data items, 

used by or for the Government of the United States of A fast Fouricr transform operation is performed in connec- 

America for governmental purposes without the payment of xion with each successive acoustic sensor signal data item to 

royalties thereon or therefor. generate a phase and amplitude beam map reflecting spectral 

10 signal energy in the received acoustic sensor signal data 

BACKGROUND OF THE INVENTION j tem , if the beam map for an acoustic sensor signal data item 

(1) Field of the Invention indicates that the item represents a signal having a signal- 

to-noise ratio above a first predetermined threshold value, a 

The present invention relates to a method for estimating beam map gene rated for a previous acoustic sensor signal 

the motion of a target relative to another object such as a data j tem j s ^td t0 generate a bounded beam map, a 

marine vessel and to a system for performing the method. 15 determination is made as to whether the bounded beam map 

(2) Description of the Prior Art represents a signal having a second predetermined signal - 
A variety of techniques and methods for target motion to-noise ratio. In response to a positive determination for the 

analysis (TMA) and tracking are known in the art. The laUer signal-to -noise determination, both the beam maps are 

purpose of many of techniques and methods is to arrive at an used t0 & enerate tracbn S "Nation for the target vehicle, 

estimation of the bearing and range, as well as the course and 20 c US * Pat ' No. 5,432 753 to Maranda illustrates a system 

the speed, of the target being tracked. One of the principal for target detection and localization with an algorithm for 

goals associated with these techniques and methods is to P^fonning TMA using data from a passive sonar array and 

• , . j i . * .» *• which works directly with beam spectra to estimate the 

provide accurate and timely estimates of the target s motion. . . 4 , \ , . ■ i_ *i_ j- * 

r j & target track. The system determines when the coordinate 

U.S. Pat. No. 5,216,815 to Bessacini illustrates a method 25 tra j ectory 0 f a hypothesized target aligns with the coordinate 

for determining range from a moving vessel to an approach- trajectory of an actual target and operates by forming 

ing object using only two bearing measurements. In this long-term integrated spectral values from short-term values 

method, a first bearing measurement to the approaching of frequency and angle coordinate values. The hypothesized 

object is obtained at a first point in time using the vessel's target track that yields the maximum long-term integrated 

conventional bearing sensor. The vessel and the approaching 30 spectral value is used as the estimate of the true target track, 

object are then postulated to be on an intercept course based A track generator is used to generate hypothesized target 

on the first vessel's velocity vector and first bearing mea- tracks for a search grid in the form of vectors that are 

surement. At a second point in time, the vessel commences clocked downward in a chain of latches. The latches are 

a maneuver to a known second velocity vector different from connected through computational elements, which are sup- 

the first velocity vector. Then, at a third point in time, a 35 plied with non-acoustic data, and RAMs to a summation 

second bearing measurement to the approaching object is pipeline, the RAMs being supplied with data from an array's 

obtained using the vessel's bearing sensor. At the same third sonar processor. The computational elements compute and 

point in time, a virtual bearing to the approaching object is provide angle and frequency addresses to the RAMs, whose 

provided as if the vessel and the approaching object were on outputs are applied to adders in the summation pipeline, 

the postulated intercept course. A time difference is com- 40 Each RAM holds data for a single two-dimensional FRAZ 

puted between the second and third points in time and spectrum. The summation pipeline supplies a completed 

standard trigonometric methods are applied to determine the sum of short-term spectral values at its output to provide the 

range to the approaching object. required long-term integrated spectral values. 

U.S. Pat. No. 5,317,543 to Grosch illustrates a method Yet another method for determining range is known as 

and a sensor for determining the distance of sound gener- 45 Ekelund ranging. This is a widely used method of target 

ating targets from acoustic signals which are subjected to a localization. One of the deficiencies of present Ekelund 

Fourier transformation. In order to determine the target methods is that they fail to fully exploit all available target 

distance, it is postulated that the acoustic signals received by data and provide only single epoch range estimates with no 

an acoustic sensor at two successive points in time are from mechanism for refinement. 

a target at distances r., and r 2 , respectively, from the acoustic 50 Under actual operating conditions, the measurement pro- 
sensor. After the Fourier transformation, an evaluation of the cess for Ekelund ranging computations consists of discrete 
phase difference in the sound spectrum yields the difference time series of target bearings corrupted by errors and taken 
between the distances of the target from the sensor at the two while the observer vessel travels along a trajectory corn- 
points in time, from which difference the target distance is prised of constant-velocity segments ("legs") interspersed 
then calculated according to a spherical wave model. 55 with maneuvers. Here, a maneuver is defined as a non-zero 
U.S. Pat. No. 5,471,433 to Hammel et al. illustrates a change in the course and/or speed of the observer platform, 
trajectory estimation system for estimating a trajectory of a At least two measurement legs of data are required for the 
target in response to a series of data items which are estimation process to become observable (feasible). The 

I generated in response to the motion of the target. The measurement time series is subdivided into distinct 

trajectory estimation system inclu des a data segmentation 60 sequences, each corresponding to a particular leg of the 

means a nd a trajectory selection means. The data segmen- observer vessel. These sequences are then processed to 

Tation means process the series of data items in accordance provide smoothed estimates of target bearing, bearing rate, 

with a regression/multiple hypothesis methodology to gen- and bearing acceleration, which are time indexed to the 

erate a plurality of segments, each having associated data midpoint of the appropriate leg. Finally, this data is made 

items which have similar features. The trajectory selection 65 available for TMA computations. 

means for processing the segments in accordance with a Current Ekelund ranging procedures are designed to use 

multiple-model hypothesis methodology to generate a cor- only two measurement legs for range estimation and totally 



07/20/2004, EAST Version: 1.4.1 



5,8' 

3 

neglect bearing acceleration data. As additional measure- 
ment legs become available, a drop-add scheme is employed 
so that only the two most recent legs are utilized in the 
computation of new time updated estimates. The existing 
procedures do not allow for estimate refinement via utiliza- 
tion of data from discarded measurement legs and/or bearing 
acceleration, even though both sources usually contain valu- 
able information about the new target range. In essence, the 
concept of reducing estimation error by expansion of the 
data measurement set is not exploited. The foregoing defi- 
ciencies typically degrade the performance of conventional 
Ekelund ranging procedures and results in sub -optimal esti- 
mation. 

SUMMARY OF THE INVENTION 

Accordingly, it is an object of the present invention to 
provide an improved method for performing target motion 
analysis. 

It is another object of the present invention to provide an 
improved method as above for providing range estimates as 
soon as two measurement legs of data become available. 

It is still another object of the present invention to provide 
a method as above having a significant reduction in estima- 
tion error. 

It is still yet another object of the present invention to 
provide a method as above which is robust, relatively simple 
to implement, and recursive in nature. 

Yet another object of the present invention is to provide a 
system for performing the method of the present invention. 

The foregoing objects, as well as others, are attained by 
the method and the system of the present invention. 

In accordance with the present invention, a method for 
providing an estimate of the motion of a target relative to an 
observer station broadly comprises the steps of: generating 
data representative of the motion of the target relative to the 
observer station during first and second measurement legs; 
processing the data to yield a smoothed estimate of the 
bearing, bearing rate and bearing acceleration of the target 
during each measurement leg; processing the smoothed 
estimate of the bearing, bearing rate and bearing acceleration 
of the target to provide a solution as to the position of the 
target relative to the observer station and the velocity of the 
target. 

The system of the present invention broadly comprises 
means for generating data representative of the motion of the 
target relative to the observer station during first and second 
measurement legs; means for processing said data to yield a 
smoothed estimate of the bearing, bearing rate and bearing 
acceleration of the target during each measurement leg; and 
means for processing the smoothed estimate of the bearing, 
bearing rate and bearing acceleration of the target to provide 
an estimate of the position of the target relative to the 
observer station and the velocity of the target. 

Other details of the method and system of the present 
invention as well as the other objects and advantages atten- 
dant thereto are set forth in the following description and 
drawings wherein like reference numerals depict like ele- 
ments. 

BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 is a schematic representation of a passive target 
motion analysis and tracking system in accordance with the 
present invention; 

FIG. 2 is a block diagram illustrating the passive local- 
ization and target motion analysis subsystem; and 
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FIG. 3 is a flowchart of the passive localization and target 
motion analysis subsystem. 

DESCRIPTION OF THE PREFERRED 
s EMBODIMENT^) 

The method of the present invention deals with the 
problem of passive TMA tracking, namely estimating the 
range, bearing, course, and speed of a target traveling with 
constant velocity from a discrete-time series of corrupted 

10 bearing measurements. FIG. 1 provides a schematic repre- 
sentation of a system for implementing the method of the 
present invention. 

Corrupted bearings are typically derived from target sen- 
sors 10 such as sonar devices on board the observer station 

15 or own ship, typically a maneuverable marine vessel. The 
sensor(s) 10 measure acoustic signals or noise emanating 
from the target. These signals are processed in a data 
preprocessing system 12 to yield smoothed and time indexed 
estimates of target bearing, bearing rate and bearing accel- 

20 eration. The data preprocessing system may comprise any 
suitable device known in the art for yielding smoothed and 
time indexed estimates of target bearing, bearing rate and 
bearing acceleration from the acoustic data generated by the 
sensor(s) 10. Preferably, the data preprocessing system 

25 comprises a preprogrammed computation device having any 
suitable architecture. 

Navigation sensors 14 on board the observer station 
simultaneously provide data measurements to a trajectory 

3Q modeling subsystem 16. The navigation sensors 14 provide 
information about the observer station which allows for 
accurate computation of the observer station position and 
velocity at all instants of time. 

As shown in FIG. 1, the system for implementing the 

35 method of the present invention has a trajectory modeling 
subsystem 16. The trajectory modeling subsystem 16 con- 
tains two modules. The first is a module 15 for creating a 
motion model of the observer station using data from the 
navigation sensors 14. The second is a module 17 for 

40 generating a target motion model. Each of these modules 
may comprise any suitable means known in the art for 
generating the desired models. Preferably, they comprise a 
preprogrammed computational devices for generating the 
models. The devices may use any desired programming 

45 known in the art to generate the models. The programming 
which is used by the modules does not form part of the 
present invention. 

As further shown in FIG. 1, the system used to implement 
the method of the present invention includes a passive 

50 localization and target motion analysis subsystem 18. As 
shown in FIG. 1, the subsystem 18 receives the smoothed 
and time indexed estimates of target bearing, bearing rate 
and bearing acceleration from the data preprocessing system 
12 as a first input. The subsystem 18 also receives inputs 

ss from the observer station motion model module 15 and the 
target motion model module 17. The subsystem 18 outputs 
target position and velocity estimates which are fed to the 
target motion model module 17 and to a display device (not 
shown). 

60 The architecture for the passive localization and target 
motion analysis subsystem 18 is shown in FIG. 2. As shown 
therein, the subsystem 18 includes a data leg determination 
unit 20 which receives the smoothed and time indexed data 
from the data preprocessing system 12. The subsystem 18 

65 further includes an initialization unit 22, a prediction unit 24, 
a correction unit 26 and a data preprocessing system return 
module 28. Each of the units 20, 22, 24, and 26 as well as 
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the return module 28 may comprise any suitable computa- where 

tion device known in the art programmed to carry out a set 

of calculations in accordance with the flowchart shown in 

FIG. 3 and described hereinafter. u 

s H 

As shown in FIG. 2, both the initialization unit 22 and the 
prediction unit 24 receive data about the observer station 
from the observer station motion model module 15 in the 
trajectory modeling subsystem 16. Additionally, the predic- 
tion unit 24 receives target data from the target motion 
model module 17 in the trajectory modeling subsystem 16. 

To assist in understanding the processing of information 
by the passive localization and target motion analysis sub- 
system 18, the following parameter definitions and ancillary 
information are provided: 

i=measurement leg number, i«l, 2, 3, . . . 
t—time at midpoint of leg i 

AT,-total length of time data measurements taken on leg 
i 

^—smoothed bearing at time t, i 
p —smoothed bearing rate at time t ( - ^ 
P^smoothed bearing acceleration at time t ( . 25 where 

9,=mat ( .) 



sin(P2 - Pi) 



(f2 - '1)COS02 



-('2 - fi)sinp2 



e^ATiXVO^sinp, + VO yl cosp\) 
(ArOfVOjiCOSp! - VDyisinpO 
(XO x2 - m-Ocosfr - P 0 * -XO yi )swfo 



and ( ) T indicates the matrix transpose. 

As shown in FIG. 3, the initial estimates of the range from 
the observer station to the target and the target velocity are 
fed to the prediction unit 24. The prediction unit takes 
smoothed data from the two most recent measurement legs 
(corresponding to i and i+1 in combination with the observer 
station data and initial estimate to compute a predicted 
estimate of the range from the observer station to the target, 
target velocity, and the error covariance matrix using the 
following equations: 

Zt+i-^k-w (3) 
A«-*4* r (4) 



XOi > 



V7V 
VT y 

VOyi 



x<- 



P31i 



VT 

P22, 
P32j 



x component of target velocity (constant) 
y component of target velocity (constant) 

x component of own ship velocity at time tj 
y component of own ship velocity at time r,* 

x component of own ship position at time r,* 
y component of own ship position at time ly 

[Range own ship to target f; 1 
Target velocity (assumed constant) J 



30 



35 



cos(fr>i - ft) (lui - 
0 
0 



r,-)sinfr + i (ff+i- 
1 
0 



/i)cosp\- + ] 
1 

0 



and 



{XO^-XOyi) cosftu 
0 
0 



fl3i 
P23; 
P33i 



- e covariance matrix associated with Xj 



The output of the prediction unit 24 is fed to the correction 
unit 26. The correction unit 26 takes smoothed data from the 
two most recent measurement legs (corresponding to i and 
i+1) in combination with the predicted estimates to compute 
a corrected estimate of the range from the observer station 
to the target, target velocity, and the error covariance matrix 
as follows: 



45 



(Xj, P^) and (Xj, f* ( ) are predicted and corrected estimates of 
(Xf, P,), respectively. 

FIG. 3 is a flowchart showing the flow of data through the 
subsystem 18. The measured data from the data preprocess- 
ing system is fed to the data leg determination unit which 
associates the data with a particular measured leg. If the 
measured leg is the first measurement leg, then the sub- 
system goes to the return module 28 to await data from a 
second measurement leg. After receiving measured data 
p from two different measurement legs, the data is fed to the 
initialization unit 22 which computes an initial estimate of 
the range from the observer station to the target for at time 
tj (assuming the target velocity to be constant) and an error 
covariance matrix. The initial estimate and the error cova- 
1— ttance matrix are computed as follows: 



where 



Xj+i^+i+GlZ-HXj+i] 

Pm-V-gh^ 



(5) 
(6) 



55 



Z - 



e i+ i(A7M)sinp i+ i 
(A7*j + i)cosPf f i 
(/ l+l - f;)cosp\- 



-(A7f +l )sinpVi 

sin(pVi - pi) (/ l+l - f;)cosp\- -(ffi - f r )sinp\ 
G/^AZiuXVO^M^uipVi + VO^f+rjcospVi) 

pO^i) - JrO„)cos& - £*0 Kitl) -XOJsmfr 



X X -H- X Z 

P 1 -/r 1 (/r 1 ) r 



(i) 

(2) 



At this point, the corrected estimation vector X, V1 can be 
65 combined with the smoothed bearing p (+J to provide an 
estimate of target position and velocity corresponding to the 
time t,- +1 . 
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As data from a new measurement leg becomes available, 
the index i is increased by one unit and the entire compu- 
tation process is repeated. In performing the method of the 
present invention, it is important that the observer station 
maneuver between measurement legs. One of the inherent 5 
features of the method of the present invention is the 
automatic time updating of the estimate of target position 
and statistical reduction of estimation error. 

It has been found that the utilization of smoothed bearing, 
bearing rate, and bearing acceleration provides improved 
range estimates as soon as two measurement legs of data 
become available. It has also been found that further reduc- 
tion of estimation error accrues as additional measurement 
legs become available and the solution is updated. This 
updating is different from other systems where the solutions 
of the range to the target are based solely upon the two most 15 
recent measurement legs. Still further, the computational 
procedure involved in the method of the present invention is 
robust, relatively simple to implement and non-iterative in 
nature. 

It is apparent that there has been provided in accordance 20 
with this invention a recursive method for target motion 
analysis and a system for performing the method which fully 
satisfies the objects, means, and advantages set forth here- 
inbefore. While the invention has been described in combi- 
nation with specific embodiments thereof, it is evident that 25 
many alternatives, modifications, and variations will be 
apparent to those skilled in the art in light of the foregoing 
description. Accordingly, it is intended to embrace all such 
alternatives, modifications, and variations as fall within the 
spirit and broad scope of the appended claims. 30 

What is claimed is: 

1. A method for estimating the motion of a target relative 
to an observer station, said method comprising the steps of: 

generating data representative of the motion of said target 
relative to said observer station during first and second 
measurement legs; 

processing said data to yield a smoothed estimate of the 
bearing rate, bearing and bearing acceleration of said 
target during each measurement leg; ^ Q 

processing said smoothed estimate of the bearing rate, 
bearing and bearing acceleration of said target to pro- 
vide an estimate of the position of the target relative to 
said observer station and the velocity of said target and 
to thereby provide an estimate of the motion of said 45 
target; and 

said data processing step comprising sensing the motion 
of the observer station using at least one navigation 
sensor; generating a model of the motion of the 
observer station; and determining an initial estimate of 50 
the range from the observer station to the target at a first 
instance of time and an error co variance matrix using 
said smoothed estimate of the bearing rate, bearing and 
bearing acceleration and data representing said model 
of the motion of said observer station. 5S 

2. The method according to claim 1 further comprising: 
maneuvering said observation station through at least a 

third measurement leg; 

sensing the position of said target relative to said observer 
station during each said subsequent measurement leg 60 
and generating data representative of the motion of said 
target relative to said observer station during said 
subsequent measurement leg; 

processing said third measurement leg data to yield a 
smoothed estimate of the bearing rate, bearing and 65 
bearing acceleration of said target for said third mea- 
surement leg; 
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inputting data representative of a model of said target 
motion into a prediction unit; and 

inputting said initial estimate of the range from the 
observer station to the target at a first instance of time 
and said initial estimate of target velocity, said 
smoothed estimate of the bearing rate, bearing and 
bearing acceleration of said target during said third 
measurement leg, and data from said observer station 
model into said prediction unit and determining a 
predicted estimate of the range from the observer 
station to the target, target velocity, and the error 
covariance matrix. 

3. The method according to claim 2 further comprising: 
inputting said predicted estimate of the range from the 

observer station to the target, target velocity, and the 
error covariance matrix into a correction unit; 

inputting the smoothed data from the second and third 
measurement legs into said correction unit; and 

determining a corrected estimate of the range from the 
observer station to the target, target velocity, and the 
error covariance matrix using said inputted predicted 
estimate and said inputted smoothed data. 

4. The method according to claim 3 further comprising 
combining the corrected estimate of the range from the 
observer station to the target with the smoothed bearing at 
the third measurement leg to provide said estimate of target 
position and velocity for the time at the midpoint of the third 
measurement leg. 

5. The method of claim 4 further comprising inputting 
said estimate of target position and velocity into said model 
of said target motion. 

6. The method of claim 5 further comprising: 
maneuvering said observer platform through subsequent 

measurement legs; and 
repeating the steps of the method to yield a further 
estimate of target position and velocity. 

7. A system for estimating the motion of a target relative 
to an observer station, said system comprising: 

means for generating data representative of the motion of 
the target relative to the observer station during first and 
second measurement legs; 

first means for processing said data to yield a smoothed 
estimate of the bearing, bearing rate, and bearing 
acceleration of the target during each measurement leg; 

second means for processing the smoothed estimate of the 
bearing, bearing rate, and bearing acceleration of said 
target to provide an estimate of the position of the target 
relative to the observer station and the velocity of said 
target and to thereby provide an estimate of the motion 
of said target; 

means for sensing the motion of said observer station; 

means for creating a model of the motion of the observer 
station using data sensed by said sensing means; 

means for creating a model of the motion of the target; 

the second means comprising means for determining an 
initial estimate of the range from the observer station to 
the target, an initial estimate of target velocity, and an 
initial error covariance matrix using the output of said 
first means and data from said observer station motion 
model creating means; and 

the second means further comprising means for determin- 
ing a predicted estimate of the range from the observer 
station to the target, a predicted estimate of target 



07/20/2004, EAST Version: 1.4.1 



5,877,998 



velocity, and a predicted error covariance matrix using 
the output of said first means, the output of said means 
for determining an initial estimate, data from said 
observer station motion model creating means, and data 
from said target motion model creating means. 
8. The system according to claim 7 wherein said second 
means further comprises means for determining a corrected 
estimate of the range from the observer station to the target, 
a corrected estimate of target velocity, and a corrected error 
covariance matrix using the output from said means for 
determining a predicted estimate of the range from the 
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observer station to the target, a predicted estimate of target 
velocity, and a predicted error covariance matrix. 

9. The system according to claim 8 wherein said means 
for determining a corrected estimate of the range from the 
observer station to the target, the corrected estimate of target 
velocity, and the corrected error covariance matrix outputs a 
signal representing an estimate of the target position and the 
target velocity. 



10 



07/20/2004, EAST Version: 1.4.1 



